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ABSTRACT 

The purposes of this research are to derive the equations of motion of a flexible two-link system by a finite 
element method, to develop computational codes in order to perform dynamics simulations with vibration control and to 
propose an effective control scheme of a flexible two-link manipulator. The flexible two-link manipulator used in this 
paper consists of two aluminum beams as flexible links, two clamp-parts, two servo motors to rotate the links and two 
piezoelectric actuators to control vibration. Computational codes on time history responses, FFT (Fast Fourier Transform) 
processing and eigenvalues - eigenvectors analysis were developed to calculate the dynamic behavior of the links. 
Furthermore, a control scheme using the piezoelectric actuators was designed to suppress the vibration. Two proportional- 
derivative controllers were designed and demonstrated their performances. The calculated results of the controlled two-link 
manipulator revealed that the vibration of the flexible manipulator can be controlled effectively even though only use one 
piezoelectric actuator. 
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INTRODUCTION 

Employment of flexible manipulators is recommended in the space and industrial applications in order to 
accomplish high performance requirements such as high-speed besides safe operation, increasing of positioning accuracy, 
and lower energy consumption, namely less weight. However it is not usually easy to control a flexible manipulator 
because of its inheriting flexibility. Deformation of the flexible manipulator when it is operated must be considered by any 
control. Its controller system should be dealt with not only its motion but also vibration due to the flexibility of the link. 

In the past few decades, a number of modeling methods and control strategies using piezoelectric actuators to deal 
with the vibration problem have been investigated by researchers [1 - 7]. Nishidome and Kajiwara [1] investigated a way 
to enhance performances of motion and vibration of a flexible-link mechanism. They used a modeling method based on 
modal analysis using the finite-element method. The model was described as a state space form. Their control system was 
constructed with a designed dynamic compensator based on the mixed of HJH^. They recommended separating the motion 
and vibration controls of the system. Yavus Yaman et al [2] and Kircali et al [3] studied an active vibration control 
technique on aluminum beam modeled in cantilevered configuration. The studies used the ANSYS package program for 
modeling. They investigated the effect of element selection in finite-element modeling. The model was reduced to state 
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space form suitable for application of H ^ [2] and spatial //<*, [3] controllers to suppress vibration of the beam. They showed 
the effectiveness of their techniques through simulation. Zhang et al [4] has studied a flexible piezoelectric cantilever 
beam. The model of the beam using finite-elements was built by ANSYS application. Based on the Linear Quadratic Gauss 
(LQG) control method, they introduced a procedure to suppress the vibration of the beam with the piezoelectric sensors 
and actuators were symmetrically collocated on both sides of the beam. Their simulation results showed the effectiveness 
of the method. Gurses et al [5] investigated vibration control of a flexible single-link manipulator using three piezoelectric 
actuators. The dynamic modeling of the link had been presented using Euler-Bernoulli beam theory. Composite linear and 
angular velocity feedback controls were introduced to suppress the vibration. Their simulation and experimental results 
showed the effectiveness of the controllers. Xu and Koko [6] studied finite-element analysis and designed controller for 
flexible structures using piezoelectric material as actuators and sensors. They used a commercial finite-element code for 
modeling and completed with an optimal active vibration control in state space form. The effectiveness of the control 
method was confirmed through simulations. Kusculuoglu et al [7] had used a piezoelectric actuator for excitation and 
control vibrations of a beam. The beam and actuator were modeled using Timoshenko beam theory. An optimized vibration 
absorber using an electrical resistive-inductive shun circuit on the actuator was used as a passive controller. The 
effectiveness of results was shown by simulations and experiment. 

In the recent two years, Muhammad et al [8-12] have actively studied vibration control on a flexible single-link 
manipulator with a piezoelectric actuator using finite-element method. Model of the single-link and the piezolecetric 
actuator was built using one-dimensional and two-node elements. They introduced a simple and effective control scheme 
with the actuator using proportional (P), PD and AF controls strategies. The effectivenesses of the proposed control scheme 
and strategies were shown through simulations and experiments. 

The purposes of this research are to derive the equations of motion of a flexible two-link system by a finite 
element method, to develop computational codes in order to perform dynamics simulations with vibration control and to 
propose an effective control scheme of a flexible two-link manipulator. The flexible two-link manipulator used in this 
paper consists of two aluminum beams as flexible links, two aluminum clamp-parts, two servo motors to rotate the links 
and two piezoelectric actuators to control vibration. Computational codes on time history responses, FFT (Fast Fourier 
Transform) processing and eigenvalues - eigenvectors analysis were developed to calculate the dynamic behavior of the 
links. An end-effector that treated as a concentrated mass was introduced to demonstrate a complete flexible two-link 
manipulator system. Finally, two proportional-derivative controllers were designed to suppress the vibration. They were 
done by adding bending moments generated by the piezoelectric actuators to the two-link system. 

FORMULATION BY FINITE ELEMENT METHOD 

The links have been discretized by finite elements. Every finite element (Element z-th) has two nodes namely 
Node z and Node (z+ 1). Every node (Node z) has two degrees of freedom [8 - 12], namely the lateral deformation v t (x,t), 
and the rotational angle y/i(x,t) . The length, the cross-sectional area and the area moment of inertia around z-axis of every 
element are denoted by l h S t and I zi respectively. Mechanical properties of every element are denoted as Young’s modulus 
E t and mass density p t . 

Kinematics 

Figure 1 shows the position vector r p \ and r p2 of arbitrary points P\ and P 2 on Link 1 and Link 2 in the global and 
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rotating coordinate frames. Let the links as flexible beams have a motion that is confined in the horizontal plane as shown 
in Figure 1. The O - XY frame is the global coordinate frame with Z-axis is fixed. Furthermore, c)\ - xiyi and o 2 - x 2 y 2 are 
the rotating coordinate frames fixed to the root of Link 1 and Link 2, respectively (z r axis and z 2 -axis are fixed). The unit 
vectors in X , Y, x h y h x 2 and y 2 axes are denoted by /, /, i 2 and j 2 , respectively. The first motor is installed on the root 
of the Link 1. The second motor that treated as a concentrated mass is installed in the root of the Link 2. The rotational 
angles of the first and second motor when the links rotate are denoted by Oi(t) and 0 2 (t). Length of Link 1 is donated by L h 
Lateral deformation of the arbitrary points Pi and P 2 in the first and the second links are donated by v p] and v p2 , 
respectively. Lateral deformation and rotational angel of the end-point of the first link are donated by v e and yj e , 
respectively. The position vector r pl and r p2 of the arbitrary points P i and P 2 at time t = t, measured in the O - XY frame 
shown in Figure 1 are expressed by 

r P i = x P i (xi,O u v pl ,t)I + Y pl (x l ,0 l ,v pl ,t)J (1) 

r p 2 = X p 2 (x 2 , 9 U 9 2 , v e ,lff e ,v p2 ,t)l + Y p2 (x 2 , 01,0 2 . ' V e ,l/' e ,V p2 ,t)J , (2) 



where 



x pi =x 1 cos(9 1 (/)-v pl (x 1 ,/)sin 0 x (t) (3) 

Y f ,i = x, sin 6 X (t) + v pl (x, , t) cos 8 ] (/) (4) 

x pl =L l cos 9 x (t) - v e (x, , t) sin 9 ] (/) + x 2 cos(^ (/) + y/ e (.r, ,t) + 0 2 (/))- v p2 (x 2 , t) sin(<9, (t) + y/ e (.r, ,t) + 0 2 (/)) (5) 
Y p2 = Lj sin 9 X (t ) + v e ( x x , t) cos 9 X ( t ) + x 2 sin(^j it) + y e (xj ,t) + 0 2 (?)) + v p2 (x 2 , t) cos(^ (?) + (xj ,t) + 9 2 (?)) (6) 
The velocity vector of the arbitrary points P i and P 2 at time t = t, shown in Fig.l is expressed by 



fpi ~ X pi( x i 9 0i,0i 9 v pi,v p i,t)I + Y p i , 6 X , 6 X , v p i , v p i , t)J 

r p 2=X p 2( x 2>0i’02’0i’02’V e ,i/f e ,v p2 ,v e ,i/f e ,v p2 J)I + Y pl (x 2 ,0 u 0 2 ,0i,0 2 ,v e ,i/f e ,v p2 ,v e ,i// e ,v p2 ,t)J 



(7) 

( 8 ) 
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Y,J 

y» h (*=o) 




0- XY : Global coordinate frame 

01- Xiyi : Rotating coordinate frame fixed to Link 1 

0 2 - x 2 y 2 • Rotating coordinate frame fixed to Link 2 

r P \, r P 2 • Position vectors of the arbitrary points p x and p 2 in the X-axis of the O-XY 

9\ : Rotational angle of the first motor 

0 2 : Rotational angle of the second motor 

X p i t X p2 : Coordinates of the arbitrary points p\ and p 2 in the X-axis of the O-XY 

Y pU Y p 2 : Coordinates of the arbitrary points p x and p 2 in the Y- axis of the O-XY 

v p i : Lateral deformation of the arbitrary point pi on Link 1 in the Oi-xiyi 

v p2 : Lateral deformation of the arbitrary point p 2 on Link 2 in the o 2 -x 2 y 2 

yj e : Rotational angle of the end-point of Link 1 

v e : Lateral deformation of the end-point of Link 1 

Li : Length of Link 1 

Figure 1: Position Vectors of Arbitrary Points Pi and P 2 in the Global and 
Rotating Coordinate Frames 



Finite Element Method 

Figure 2 shows the element coordinate frame of Element /- th , and an arbitrary point P on Element i- th. Here, there 
are four boundary conditions together at nodes i and (7+1) when the one-dimensional and two-node element is used. The 
four boundary conditions are expressed as nodal vector as follow 

<5,=k ¥i v w YmY ( cu 
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V; 




Figure 2: Element Coordinate Frame of Element i- th 

Then, the hypothesized deformation has four constants as follows [13] 



2 3 

V; = a 1 + a 2 x t + a 2 x i + a 4 x i 



( 10 ) 



where x t is position coordinate of the arbitrary point P in the x,-axis of the element coordinate frame. Then, the 
relation between the lateral deformation v, and the rotational angle if/, of the Node i is given by 



Vi = 



dvt_ 

dX: 



(ID 



Moreover, from mechanics of materials, the strain of Node i can be defined by 
a 2 v ; 

*,• = -y t 



dx, 2 

where y, is position coordinate of the arbitrary point P in the v,-axis of the element coordinate frame. 

Equations of Motion 

Equations of motion of Element /-th on Link 1 and Link 2 are respectively given by 



( 12 ) 



M 



A + C i 'd i + [k, - 0, 2 M ; ] <5; = OJi 



(13) 



Af jdj + C fdf + 



K i ~ i&\ + W e + d 2 ) M , 8, - (d, +i/jr e +0 2 )/,- + [l\ 0\ + v e - v,.#, 2 )cos(^ ( , + 0 2 )g t 



(14) 



+ \ V A +L A 2 + -V«( 3 ^l +0 2 )Si 



where M h Ci , and K h are the mass matrix, damping matrix, stiffness matrix of Element i - th on Link 1 and Link 2. 
Vectors of/ and g t are the excitation vectors on Link 1 and Link 2. The representation of the matrices and the vector of / 
can be found in [8] and [10]. The vector of g, can be defined by 
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*,-=^{-6 15 /, 6 l,Y 



(15) 



Finally, the equations of motion of Link 1 and Link 2 with n elements considering the boundary conditions is 

given by 



M n s n +Cj n + [k„ - e 2 m n ] S n = ej n 



(16) 



M n<>n + C n<>n + 



K n -{dl+Ve +@ 2 ) M n S n ~ (#1 + \jf e + 0 2 )f n + + V e ~ V e 6\ )cOs(^ e + 0 2 )g n (17) 



+ [ V e&l + L \0\ 2 ~¥e — ^2 ) | sin +^ 2 )^^ 



VALIDATION OF THE FORMULATION 



Experimental Model 

Figure 3 shows the experimental model of the flexible two-link manipulator. The flexible manipulator consists of 
two flexible aluminum beams, two clamp-parts, two servo motors and the base. Link 1 and Link 2 are attached to the first 
and second motors through the clamp-parts. Link 1 and Link 2 are connected through the second motor. Two strain gages 
are bonded to the position of 0.11 [m] and 0.38 [m] from the origin of the two-link system. The first motor is mounted to 
the base. In the experiments, the motors were operated by an independent motion controller. 




Figure 3: Experimental Model of the Flexible Two-Link Manipulator 

Computational Models 



In this research, we defined and used five types of computational models of the flexible two-link manipulator. 



Model I 



A model of only a two-link manipulator was used as Model I . Figure 5. a shows Model I . The links and the 
clamp-parts were discretized by 35 elements. Two strain gages are bonded to the position of Node 6 and Node 22 of the 
two-link (0.11 [m] and 0.38 [m] from the origin), respectively. 

Model II 

A model of the flexible two-link manipulator including one piezoelectric actuator was defined as Model II . 
Figure 5.b shows model II . The piezoelectric actuator was bonded to the one surface of elements 4. The links including the 
clamp-parts and the piezoelectric actuator were discretized by 36 elements. 
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The piezoelectric actuator suppresses the vibration of the two-link flexible manipulator by adding bending 
moments at nodes 3 and 6 of the two-link manipulator, M 3 and M 6 . The bending moments are generated by applying 
voltages Ei to the piezoelectric actuator. The bending moments proportional to the voltage which are expressed by 

M 3 =-M 6 =d n E l (18) 

Here d xx is a constant quantity and M 3 opposites to M 6 . 

Furthermore, the voltage to generate the bending moments is proportional to the strains s x of the two-link due to 
the vibration. The relations can be expressed as follows 

E l =±-Ee l (19) 

d 2 i 

Here d 2 1 is a constant quantity. 

Model IE 

A model of the flexible two-link manipulator including the two piezoelectric actuators was defined as Model III . 
Figure 5.c shows model n. The piezoelectric actuators were bonded to the one surface of elements 4 and 20. The links 
including the clamp-parts and the piezoelectric actuators were discretized by 36 elements. Schematic representations on 
modeling of the piezoelectric actuators are shown in Figure 4. Physical parameters of the flexible two-link manipulator 
model and the piezoelectric actuators are shown in table 1 . 

The first piezoelectric actuator suppresses the vibration of the two-link flexible manipulator by adding bending 
moments at nodes 3 and 6 of the two-link manipulator, M 3 and M 6 . The second piezoelectric actuator suppresses the 
vibration of the two-link flexible manipulator by adding bending moments at nodes 19 and 22 of the two-link manipulator, 
Mi 9 and M 22 . The bending moments are generated by applying voltages E x and E 2 to the piezoelectric actuators. The 
bending moments proportional to the voltages which are expressed by Eq. (18) and 

M 19 =-M 22 = d l2 E 2 (20) 

Here d X2 is a constant quantity and M X9 opposites to M 22 . 

Furthermore, the voltages to generate the bending moments are proportional to the strains s x and s 2 of the two-link 
due to the vibration. The relations can be expressed by Eq. (19) and 

E 2 =±-j-e 2 ( 21 ) 

^22 

Here d 22 is a constant quantity. Then, d xx , d X2 , d 2X and d 22 will be determined by comparing the calculated results 
and experimental ones. 

Model IV 

Figure 5.d shows model IV that an end-effector is considered for a two-link manipulator with a piezoelectric 
actuator. Model IV is used to show that the proposed control scheme is also suitable for such system. The end-effector is 
presented by adding a concentrated mass to Model II . In this case, the equation of motion of the tip element containing the 
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concentrated mass is given by 

[ M i +M icm \'d i +C i d i + K t - (#, + \j/ e + 0 2 ) \M i +M icm \ = (#i + Ye + &2 ){fi +//cm} + (22) 

(M +V e -V.^jcosfo + 0 2 ){s, +Sicm} + [v e d\ + L A 2 +^Ve( 3 01 ~V e ~ &2 )jsin(^ + 6 2 ){g, + g wm } 
where the vectors of f icm and g icm are given by 

ftan=m c { 0 o Of (23) 

^. em =m c {0 0 -1 Of (24) 

and the concentrated mass matrix M icm can be expressed as 

0 0 0 0 

0 0 0 0 

0 0 m c 0 

0 f 0 0 0 

where m c is the mass of the concentrated mass. 

Model V 

Figure 5.e shows model V that an end-effector is considered for a two-link manipulator with two piezoelectric 
actuators. Model V is used to show that the proposed control scheme is also suitable for such system. The end-effector is 
presented by adding a concentrated mass to Model IE. In this case, the equation of motion of the tip element containing the 
concentrated mass is given by Eq. (22) 






(a) 



(b) 



Figure 4: Modeling of Piezoelectric Actuators: (a) Modeling of Actuator 1, (b) Modeling of Actuator 2 



z z 




Clamp-part 1 Clamp-part 2 



(a) Model I : Only Two-Link 
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> X 



Actuator 

(b) Model II : Two-Link with a Piezoelectric Actuator 



z z 



{B~* y 




Actuator 1 Actuator 2 



(c) Model IE : Two-link with Two Piezoelectric Actuators 

z z 




Actuator 



(d) Model IV : Two-Link with a Piezoelectric Actuator and an End-Effector 

z z 




Actuator 1 Actuator 2 



(e) Model V : Two-Link with Two Piezoelectric Actuators and an End-Effector 
Figure 5: Computational Models of the Flexible Two-Link Manipulator 
Table 1: Physical Parameters of the Flexible Two-Link and the Piezoelectric Actuators 



l : Total length 


m 


4.05 x 10 _1 


l\ : Length of Link 1 


m 


1.90 x 10' 1 


l 2 : Length of Link 2 


m 


2.15 x 10 _1 


l c i, l c 2 : Length of clamp-parts 1 and 2 


m 


1.50 x 10’ 2 


l a i, l a2 : Length of Actuators 1 and 2 


m 


2.00 x 10’ 2 


S/i, S/ 2 : Cross section area of links 1 and 2 


m 2 


1.95 x 10‘ 5 


S C b S c 2 : Cross section area of clamp-parts 1 and 2 


m 2 


8.09 x 10‘ 4 
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S a u S a2 : Cross section area of actuators 1 and 2 


m 2 


1.58 x 10' 5 


7 z/ i, I z a : Cross section area moment of inertia around z-axis of links 1 and 2 


m 4 


2.75 x 10 12 


I zc u ha : Cross section area moment of inertia around z-axis of clamp-parts 1 and 2 


m 4 


3.06 x 10' 8 


I za i, I za2 : Cross section area moment of inertia around z-axis of actuators 1 and 2 


m 4 


1.61 x 10 11 


E n , Ei 2 : Young’s Modulus of links 1 and 2 


GPa 


7.03 x 10' 


E c i, E c 2 : Young’s Modulus of clamp-parts 1 and 2 


GPa 


7.03 x 10* 


E a i, E a 2 : Young’s Modulus of actuators 1 and 2 


GPa 


4.40 x 10 1 


pn,pi 2 : Density of links 1 and 2 


kg/m 3 


2.68 x 10 3 


pd , p c 2 • Density of clamp-parts 1 and 2 


kg/m 3 


2.68 x 10 3 


pa \ , pai • Density of actuators 1 and 2 


kg/m 3 


3.33 x 10 3 


oq, a 2 : Damping factor of links 1 and 2 


s' 1 


Ox 10' 4 


Ei, E 2 : Maximum input voltages of actuators 1 and 2 


V 


150.00 


Fi, F 2 : Maximum output forces of actuators 1 and 2 


N 


200.00 


m 2 : Mass of the second motor 


g 


113.53 



Time History Responses of Free Vibration 

Experiment on free vibration was conducted using an impulse force as an external one. Figure 6. a shows the 
experimental time history response of strains, s e on the free vibration at the same position in the calculation (0.11 [m] from 
the origin of the two-link system). 




(a) 



(b) 



Figure 6: Time History Responses of Strains on Free Vibration: (a) Experimental Strains at 0.11 [m] from 
the Origin of the Two-Link, (b) Calculated Strains at Node 6 of Model I 



Furthermore, the computational codes on time history response of Model I were developed. Figure 6.b shows the 
calculated strains at Node 6 of Model I under the impulse force. 

Time History Responses of Free Vibration 

Both the experimental and calculated time history responses of strains on free vibration were transferred by FFT 
processing to find their frequencies. Figures 7. a and 7.b show the experimental and calculated natural frequencies of the 
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flexible two-link manipulator, respectively. The first experimental natural frequency, 1.79 Hz agreed with the calculated 
one, 1.80 Hz. The second experimental natural frequency could not be measured. However, in the calculation, it could be 
obtained as 8.95 Hz. 





(a) (b) 

Figure 7: Natural Frequencies: (a) Experimental Natural Frequency of the Flexible Two-Link, (b) Calculated 

Natural Frequencies of Model I 

Eigen- Values and Eigen- Vectors Analysis 



The computational codes on Eigen-values and Eigen-vectors analysis were developed for natural frequencies and 
vibration modes. The calculated results for the first and second natural frequencies were 1.79 Hz and 8.92 Hz, respectively. 
The vibration modes of natural frequencies are shown in Figure 8. 




— 

o 

N 



~0X 

o 

- 0.2 

-0.4 

- 0.6 

- 0.8 

-1 




Positions of the nodes in the link [m] 



Positions of the nodes in the link [m] 



(b) First Vibration Mode and Natural Frequency (f x = 1.79 Hz) (a) Second vibration Mode and Natural Frequency (f 2 = 8.92 Hz) 

Figure 8: Vibration Modes and Natural Frequencies 



Time History Responses Due to the Base Excitations 

Another experiment was conducted to investigate the vibration of the flexible two-link due to the base excitations 
generated by rotation of the motors. In the experiment, the motors were rotated by the angle of n/2 radians (90 degrees) 
within 0.50 [s]. Figures 11. a and 12. a show the experimental time history responses of strains of the flexible two-link due 
to the motors’ rotation at 0.11 [m] and 0.38 [m] from the origin of the link, respectively. Furthermore, based on Figures 
11. a and 12. a, the time history response of strains at Node 6 and Node 22 of Model I were calculated as shown in Figures 
ll.b and 12.b, respectively. 
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(a) (b) 

Figure 11: Time History Responses of Strains Due to Base Excitation: (a) Experimental Strains at 0.11 [m] from the 
Origin of the Two-Link, (b) Calculated Strains at Node 6 of Model I 





(a) (b) 

Figure 12: Time History Responses of Strains Due to Base Excitation: (a) Experimental Strains at 0.38 [m] from the 
Origin of the Two-Link, (b) Calculated Strains at Node 22 of Model I 



CONTROL SCHEME AND SIMULATIONS 

Control Scheme 

A control scheme to suppress the vibration of the two-link system was designed using one and two piezoelectric 
actuators. It was done by adding bending moments generated by the piezoelectric actuators to the two-link system. To drive 
the actuators, two proportional-derivative (PD) controllers have been designed and examined. 

Using a Piezoelectric Actuator 

The piezoelectric actuator suppresses the vibration of the two-link flexible manipulator by adding bending 
moments at nodes 3 and 6 of the two-link manipulator, M 3 and M 6 . Therefore, the equation of motion of Link 1 become 

M nK +C n K + [ K n -&l 2 M n] <>n = &\f n + M 1 n 
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where the vector of u hl containing M 3 and M 6 is the control force generated by the actuator to the two-link system. 
Furthermore, substituting Eq. (19) to Eq. (18) gives 

M 3 ,M 6 =±^-£, (27) 

d 2l 

Based on Eq. (27) the control force can be defined in s-domain as follows 

l / ln( s ) = G C l( s )( £ d( s )- £ 6 ( s )) ( 28 ) 

where s d and s 6 denote the desired and measured strains at Node 6, respectively. The gain of PD-controller can be 
written by a vector in ^-domain as follows 

G cl (s) = {0 0 0 K pl +K dl s 0 ~{K pl +K dl s) 0 ••• o} r (29) 



A block diagram of the PD-controls for the two-link system using one actuator is shown in Figure 13. 



r8{s)f n 



£d(s) 



G c (s) 









G p (s) 



£i(s) 



Controller 



Flexible link 



s d : Desired strain s t : Measured strains at Node 6 

F : Base excitations U n : Bending moments 

Figure 13: Block Diagram of PD-Controller of the Flexible Two-Link Manipulator 

Using a Piezoelectric Actuator 



Using Two Piezoelectric Actuators 

The first piezoelectric actuator suppresses the vibration of the two-link flexible manipulator by adding bending 
moments at nodes 3 and 6 of the two-link manipulator, M 3 and M 6 , as explained in sub-chapter 4.1.1. The second 
piezoelectric actuator suppresses the vibration of the two-link flexible manipulator by adding bending moments at nodes 19 
and 22 of the two-link manipulator, M 19 and M 2 2 . Therefore, the equation of motion of Link 1 is shown in Eq. (26) and the 
equation of motion of Link 2 in given by 



M n <>n + C n d n + 



K n “(^1 +Ve +^2) M n S n - (#! +y/ e +0 2 )fn + {^1 + ^e ~ V e^\°^e +^ 2 )^n (^ 0 ) 



+ f V e Oy + LA 2 +^V e ( 3 ^ ~We -82 )) sin (We + 8 2 )Sn + « 



2 n 



where the vector of u 2n containing M i9 and M 22 is the second control force generated by the second piezoelectric 
actuator to the two-link system. 



Furthermore, substituting Eq. (21) to Eq. (20) gives 
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M\t),M 2 2 = -~~ £ 2 ( 31 ) 

d 2 2 

Based on Eq. (31) the second control force can be defined in ^-domain as follows 

U 2 „(s) = G C2 (s){e d (s)-e 22 (s)) ( 32 ) 

where s d and s 2 2 denote the desired and measured strains at Node 22, respectively. The gain of the second 
PD-controller can be written by a vector in s-domain as follows 

G c2 W = {o 0 0 K p2 +K d2 s 0 ~{K p2 +K d2 s) 0 - o} 7 ' (33) 

A block diagram of the PD-controls for the two-link system using one actuator is shown in Fig. 14. 



S«a(s) 



->6 






\ k 


Cf 1 {*) 










Controller 1 
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Flexible link 
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£22d(s) - — o 

- A 

Controller 2 



s d : Desired strain s 6 and s 2 2 • Measured strains at nodes 6 and 22 

F : Base excitations U ln and U 2n ' Bending moments generated by actuator 1 and 2 
Figure 14: Block Diagram of PD-Controllers of the Flexible Two-Link Manipulator 
Using Two Piezoelectric Actuators 

Calculated Results 

Time history responses of strains at Node 6 and Node 22 on the uncontrolled and controlled system were 
calculated for Models II , III , IV and V when the first and second motors rotated n/A radians (45 degrees) and n/2 radians 
(90 degrees) within 0.50 [s], respectively. Time history responses of strains on the controlled system for Models III and IV 
were calculated under control scheme shown in Figure 13. Time history responses of strains on the controlled system for 
Models III and V were calculated under control scheme shown in Figure 14. The concentrated mass, m c used as the 
end-effector is 14.49 [g]. 

Examining several gains of the PD-controller using one actuator leaded to K p = 2 [Nm] and K d - 0.6 [Nms] as the 
better ones. Furthermore, examining several gains of the PD controllers of the controlled system using two actuators leaded 
to K pX = 2 [Nm], K d i = 0.6 [Nms], K p2 = 40 [Nm] and K d2 =10 [Nms] as the better ones. The controller gains were 



► Q2<J) 



U2n [?) 
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examined considering the maximum output forces of the actuators. Figures 15, 16, 17 and 18 show the uncontrolled and 
controlled time history responses of strains for Models II , III , IV and V , respectively. 





Time, t [s] 
(b) 



Figure 15: Calculated Time History Responses of Strains for Model II Due to the Base Excitations: (a) at Node 

6, (b) at Node 22 





Time, t [s] 
(b) 



Figure 16: Calculated Time History Responses of Strains for Model IE Due to the Base Excitations: (a) at Node 6, 

(b) at Node 22 





Figure 17: Calculated Time History Responses of Strains for Model IV Due to the Base Excitations: 

(a) at Node 6, (b) at Node 22 
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Figure 18: Calculated Time History Responses of Strains for Model V 
Due to the Base Excitations: (a) at Node 6, (b) at Node 22 



The maximum strains of uncontrolled system for Model II at Node 6 and Node 22 were 948.30 x 10' 6 and 58.55 
x 10' 6 , respectively. By using PD-controller they become 453.50 x 10' 6 and 39.13 x 10~ 6 , respectively, as shown in figures 
15. a and 15.b. The maximum strains of uncontrolled system for Model III at Node 6 and Node 22 were 987.80 x 10‘ 6 and 
51.56 x 10' 6 , respectively. By using PD-controller they become 418.50 x 10~ 6 and 29.30 x 10~ 6 , respectively, as shown in 
figures 16. a and 16.b. 

Moreover, the maximum strains of uncontrolled system for Model IV at Node 6 and Node 22 were 1265.00 x 10' 6 
and 81.46 x 10‘ 6 , respectively. By using PD-controller they become 583.70 x 10‘ 6 and 48.29 x 10' 6 , respectively, as shown 
in figures 17. a and 17.b. The maximum strains of uncontrolled system for Model V at Node 6 and Node 22 were 1283.00 
x 10' 6 and 68.30 x 10' 6 , respectively. By using PD-controller they become 583.30 x 10' 6 and 39.87 x 10' 6 , respectively, as 
shown in figures 18. a and 18.b. 

It was verified from these results that the proposed control scheme can effectively suppress the vibration of the 
flexible two-link manipulator. 

CONCLUSIONS 

The equations of motion for the flexible two -link manipulator had been derived using the finite element method. 
Computational codes had been developed in order to perform dynamics simulations of the system. Experimental and 
calculated results on time history responses, natural frequencies and vibration modes show the validities of the formulation, 
computational codes and modeling of the system. Two proportional-derivative controllers were designed to suppress the 
vibration of the system. The calculated results have been revealed that the vibration of the system can be suppressed 
effectively even though using only one piezoelectric actuator. 
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